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^D ' Abstract 

o : 

^v^ ^ The present paper proposes a unified geometric framework for coordinated motion on 

Lie groups. It first gives a general problem formulation and analyzes ensuing conditions 
for coordinated motion. Then, it introduces a precise method to design control laws in 
fully actuated and underactuated settings with simple integrator dynamics. It thereby shows 
QQ ■ that coordination can be studied in a systematic way once the Lie group geometry of the 

fSJ ' configuration space is well characterized. This allows among others to retrieve control laws 

in the literature for particular examples. A link with Brockett's double bracket fiows is also 
made. The concepts are illustrated on SO(3), SE{2) and SE{3). 



1 Introduction 



u 
o 

C^ . Recently, many efforts have been devoted to the design and analysis of control laws that co- 

ordinate swarms of identical autonomous agents — see e.g. oscillator synchronization |531 I52j . 
flocking mechanisms [El [5], vehicle formations [121 dOl ISSl [HI [HI [20j, spacecraft formations 
[2Il [m [221 [211 [261 [m [38], mechanical system networks [50l [131 [31] and mobile sensor networks 
h> ■ [151 H51 H51 [^ [51] . For systems on vector spaces, so-called consensus algorithms have been shown 

\Q I to be efficient and robust (301 ^l [SH [3^1 [13 \EM i ^^'^ allow to address many relevant engineering 

issues and tasks (301 [HI [M]. However, in many of the above applications, the agents to coordinate 
^r ' evolve on nonlinear manifolds: oscillators evolve on the circle 5*^ = SO{2), satellite attitudes on 

50(3) and vehicles move in SE{2) or 5* £'(3); these particular manifolds actually share the gco- 



r*~" ' metric structure of a Lie groups. Coordination on nonlinear manifolds is inherently more difficult 



than on vector spaces. The goal of the present paper is to propose a unified geometric framework 
for coordinated motion on Lie groups, from a geometric definition of "coordination" to a purely 
geometric derivation of control laws for coordination like those proposed in [IHl [Ml [HI [31 [12 [S] , 
in fully actuated and underactuated settings with simple integrator dynamics. 



Symmetries The starting point for the developments in this paper is to assume invariance or 
symmetry in the behavior of the swarm of agents with respect to their absolute position on the Lie 
group: only relative positions of the agents matter. In the 3-dimensional physical world, the laws 
governing interactions in a set of particles are invariant with respect to translations and rotations 
of the whole set as a rigid body. From this viewpoint, the invariance assumption comes down to 
assuming that there is no external influence acting on the agents. The symmetries of the system 
determine how to define meaningful quantities for the swarm, like "relative positions" , and what 
the dynamics of the coupled agents can be. Coordinated motion — in short coordination — is 
defined as all situations where the relative positions of the agents are fixed. Feedback control laws 
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that asymptotically enforce coordination must be designed on the basis of error measurements 
involving appropriately invariant quantities (e.g. relative agent positions) only. 



Previous work Results about synchronization ("reaching a common point") and coordinated 
motion ( "moving in an organized way" ) on vector spaces are becoming well established [551 1301 
I36[l34j . Because a vector space can be identified with its tangent plane, both synchronization and 
coordinated motion can be seen as consensus problems on the same vector space: the former is a 
position consensus while the latter is a velocity consensus. In contrast when the configuration space 
is a Lie group, synchronization and coordinated motion are fundamentally different things. The 
geometric viewpoint for dynamical systems on Lie groups is a very well studied subject; see basic 
results in (TBI [J for simplified dynamics like those considered in the present paper, and [251 [^ [^[T] 
for a geometric theory of mechanical systems on Lie groups. General results for synchronization on 
compact Lie groups are proposed in [40] ; see also [40] for links to related examples in the literature. 
But to the best of the authors' knowledge, a unified geometric viewpoint for coordinated motion — 
in short coordination — on Lie groups is still lacking. Close to the present paper in its geometric 
flavor, [7] builds invariant observers for systems with Lie group symmetries; observer design can 
be seen as two-agent leader- follower synchronization on Lie groups. 

In applications, the ubiquitous example of motion on Lie groups is a rigid body in K". When 
translational motion is discarded, the configuration space reduces to the compact Lie group SO{n); 
an element of SO{n) can be represented by the n x n rotation matrix between a frame attached 
to the rigid body and a hypothetical fixed reference frame. The standard example of this type 
is satellite attitude control, where synchronization, i.e. obtaining equal orientations, has recently 
attracted much attention [171[Sa[lIlElliaill[311[3Il[331llll[ni[3H], with and without external 
reference tracking; note that synchronization is a very special case of coordination. Considering 
rotations and translations, the configuration space of an n-dimensional rigid body becomes the 
non-compact Lie group SE{n) = R" k SO{n). Recently, coordination has been investigated on 
5^(2) [II mug and SE{i) HOI US [SHI [13] in the underactuatcd setting of steering control where 
the linear velocity is fixed in the body's frame. Motion on SE{n) with steering control is also 
directly linked to the evolution of a Serret-Frenet frame with curvature control, as explained in 
[16| . Results taking into account the full mechanical dynamics for rigid body motion are more 
difhcult to obtain — see for instance applications of the framework of [25] for coordination on 
50(3) and SE{^) in |3T1[33] and (501 [13] respectively. Considering simphfied dynamics, as in the 
present paper, can be useful either to build a high-level planning controller or as a preliminary 
step towards an integrated mechanical controller, as illustrated for synchronization on 50(3) in 
[42] and [m [39] respectively. 



Contributions The main goal of the present paper is to provide a unified geometric framework 
for coordinated motion on Lie groups, proceeding as follows, (i) Coordination on Lie groups 
is defined from first principles of symmetry, distinguishing three variants: left-invariant, right- 
invariant and total coordination, (ii) Expressing the conditions for coordination in the associated 
Lie algebra, a direct link is drawn between coordination on Lie groups and consensus in vector 
spaces, (iii) It is investigated how total coordination restricts compatible relative positions through 
a geometrically meaningful relation. These properties are independent of the system's dynamics. 
Going over to control laws, simplified first-order dynamics are assumed for individual agents, but 
underactuation is explicitly modeled; communication among agents is restricted to a reduced set 
of links that can possibly be directed and time- varying, (iv) Control laws based on standard vector 
space consensus algorithms are given that achieve the easier tasks of right-invariant coordination 
and fully actuated left-invariant coordination on general Lie groups, for any initial condition, (v) A 
general method is proposed to design control laws that achieve total coordination of fully actuated 
agents when the communication links among agents are undirected and fixed; extension to more 
general communication settings can be made along the lines of [49j . Total coordination design 



for fully actuated agents is a rather academic problem, but (vi) the proposed design methodology 
is then shown to apply to the practically most relevant problem of left-invariant coordination 
of underactuated agents. The proposed controller architecture consists of two steps, obtained 
by adding to the consensus algorithm a position controller derived from geometrical Lyapunov 
functions. The position controllers are directly linked to the double bracket flows of |H| for gradient 
systems on adjoint orbits. 

The power of the geometry is illustrated on 5*0(3), SE{2) and SE{3) by analyzing the meaning 
of the geometric conditions for coordination, and by designing corresponding control laws with the 
proposed general methodology. The latter leads to controllers that have been previously proposed 
in the literature, but were derived based on intuitive arguments for these particular applications. 
In that sense, the novelty of the present paper is not in the expression of the coordinating control 
laws but in showing that they can be derived in a unifying and algorithmic manner with the proper 
geometric setting. 



Table of contents The paper is organized as follows. Section 2 examines the geometric proper- 
ties of coordination on Lie groups (contributions (i), (ii) and (iii)). Section 3 presents the control 
setting and basic control laws for right-invariant coordination and fully actuated left-invariant 
coordination (contribution (iv)). Sections 4 and 5 present control law design methods respec- 
tively for total coordination (contribution (v)) and for underactuated left-invariant coordination 
(contribution (vi)). Examples are treated at the end of Sections 2, 4 and 5. 

2 The geometry of coordination 

This section proposes definitions for coordination on Lie groups by starting from basic symmetry 
principles. It establishes conditions on the velocities for coordination and examines their impli- 
cations. Except that the symmetries must be compatible, these developments are independent of 
the dynamics considered for the control problem. Notations are adapted from [T]. 

2.1 Relative positions and coordination 

Consider a swarm of A^ "agents" evolving on a Lie group G, with gk{t) G G denoting the position 
of agent k at time t. Let g^ denote the group inverse oi gu, Lh ■ g ^^ hg denote left multiplication, 
and Rh : g t-^ gh right multiplication on G. 

Definition 1: The left-invariant relative position of agent j with respect to agent k is Xjk — g^ gj- 
The right-invariant relative position of agent j with respect to agent k is pjk = gj g^ ■ 

Indeed, Xjk (resp. pjk) is invariant under left (resp. right) multiplication: {hgk)~^{hgj) ~ 
9k 9j ^^ S ^- ^^^ left-/right-invariant relative positions are the joint invariants associated to 
the left-/right-invariant action of G on G x G... x G {N copies). 

The two different definitions of relative position lead to two different types of coordination; a 
third type is defined by combining them. 

Definition 2: Left- invariant coordination (LIC) means constant left-invariant relative positions 
\jk{t) = ff/T gj — resp. right-invariant coordination (RIC) means constant right-invariant relative 
positions pjk — gjgk — for all pairs of agents j, k in the swarm. Total coordination (TC) means 
simultaneous left-invariant and right-invariant coordination: g^ gj and gjg]^ are constant for all 
pairs of agents j, k in the swarm. 

The present paper thus associates coordination to fixed relative positions. In contrast, syn- 
chronization is the situation where all agents are at the same point on G: gk = gj Vj, k] this is a 
very particular case of total coordination. 



2.2 Velocities and coordination 

Denote by g the Lie algebra of G, i.e. its tangent plane at the identity e. Denote by [ , ] the 
Lie bracket on g. Let Lh* : TGg — > TG^g and Rh* ■ TGg — > TGgh for all g S G be the induced 
maps on tangent spaces corresponding to left- and right-multiplication L^ and R^ respectively. 
Let Adg ■■ Q^ Q, Adg = Rg-i^Lg^.. 

Definition 4- The left-invariant velocity ^^ G g and the right-invariant velocity ^^ G g of agent k 
are defined by C[(t) = Lg-i^^^^{-^gk{t)\t=r) and ^^(t) = Rg-i(r)*{jrt9k{t)\t=T) respectively 

The left-invariant (resp. right-invariant) velocity is such that Qkit) and Lhgk(t) (resp. Rhgk{t)) 
have the same velocity ^\.{t) (resp. ^^(i)), for any fixed h € G. Note the important equality 

a = Adg^^k ■ (1) 



Proposition 1: Left-invariant coordination corresponds to equal right-invariant velocities ^^ = ^^ 
Vj, k. Right-invariant coordination corresponds to equal left-invariant velocities ^' = ^\, \/j, k. 

Proof: For \,k, ^(fffc"'.?,) = L^-i^f^g, + Rg^.^g^^ . But if j-^gu = Lg.^H then j-^g^^ = 
-Lg-^AdaA- Thus iig^'g,) = Lg-^g,.i\-Lg-^.R,.*Adg,ii = L^-^^^^Ad-^{Adg^S,\~Adg,ii)■ 
Since L -i ^ and Ad -i are invertible, ^{\jk) = is equivalent to Adg. ^' — Adg^ S,\, or equiva- 
lently Slj = SJ^. The proof for right-invariant coordination is strictly analogous. A 

Proposition 1 shows that coordination on the Lie group G is equivalent to consensus in the 
vector space g. The latter is a well-studied subject [551 [3D1 [5^1 [371 [Ml [M] • Total coordination 
requires simultaneous consensus on ^[. and ^^; but the latter are not independent, they are linked 
through ([T]) which depends on the agents' positions. 

Proposition 2: Total coordination on a Lie group G is equivalent to the following condition in the 
Lie algebra g: 

V/fc = 1...N, $[ = C' e n ker(AdA,, - Id) or equivalently Ck^C ^[\ ker(Adp.^ - Id) 

Proof: RIC requires ^[, = ^' Vj, k; denote the common value of the ^[. by £,K Then LIC requires 
Adg^ ^' = Adg. ^' <^ ^' = ^c?A,fc C' Vj, k. The proof with £,'' is similar. A 

Proposition 2 shows that total coordination puts no constraints on the relative positions when 
the group is Abclian, since Ad\. ~ Id in this case. In contrast, on a general Lie group, total 
coordination with non-zero velocity can restrict the set of possible relative positions as follows. 

Proposition 3: Let GM^^ := {g ^ G : Adg ( = (}. 

a. For every ^ £ g, GAI^ is a subgroup of G. 

b. The Lie algebra of GM^ is the kernel of ad^ = [^,], i-s. cm^ = {v ^ Q ■ Ki v] = 0}. 

Proof: a. Ade ^ = ^ V^ since Ade is the identity operator. Adg ^ = ^ implies Adg-i ■^ = C by simple 
inversion of the relation. Moreover, if Adg.^ C = ^ and Adg^ ^ — ^, then Adg-^g^ (, = Adg^ Adg^ ^ = 
Adg-^ ^ = £,. Thus GM^ satisfies all group axioms and must be a subgroup of G. 
h. Let g{t) G CM{£_) with g{T) ~ e and ^<7(0lr = V- Then ry G cm^ = the tangent space to CM^ 
at e. For constant ^, Adg{t)^ = £_ imphes -^{Adg{t))£_ = 0, with the basic Lie group property 
-j^{Adg{t))\T = ad,j. Therefore [77, ^] = is necessary, ft is also sufficient since, for any 77 such that 
[Vi £,] — 0; the group exponential curve g{t) = exp{r]t) belongs to GM^. A 

GM^ and cmj arc called the isotropy subgroup and isotropy Lie algebra of ^; these are classical 
mathematical objects in group theory [55]. From Propositions 2 and 3, one method to obtain 
a totally coordinated motion on Lie group G is to (1) choose ^' in the vector space g and (2) 
position the agents such that Xjk G GM^i for a set of pairs j, k corresponding to the edges of a 



connected undirected graph. Then indeed, ^[. = ^' Vfc ensures RIC , and Xjk G CAI^i implies 
^^Ajfc^A; = Cfe = ^] such that £_l = ^dg^£_l = Adg.^j = ^J and LIC is achieved as weh. The same 
can be done with ^'" and the pjk- Note that a swarm at rest (^^ = f ^ = Vfc) is always totally 
coordinated. 

Remark 1: In many applications involving coordinated motion, reaching a particular configuration, 
i.e. specific values of the relative positions, is also relevant. [40] defines specific configurations as 
extrema of a cost function. Imposing relative positions in the (intersection of) set(s) CM(^ for some 
^ can be another way to classify specific configurations; unlike [40] . it works for non-compact Lie 
groups. For compact groups, there seems to be no connection between configurations characterized 
through CM^ and those defined by [iU] . 

Remark 2: It is also possible, conversely, to consider fixed relative positions Xjk and characterize 
the set of velocities ^ compatible with total coordination. For non-Abclian groups and a sufficiently 
large number N of agents, this set gcnerically reduces to ^ = 0. 

2.3 Examples 

The special orthogonal groups SO{n) and special Euclidean groups SE{n), n > 2, are well char- 
acterized; their basic properties can even be found in control textbooks like (TB]. Left-invariant 
coordination for the particular examples of SE{2) and SE(2>) was already formulated in Lie group 
notation in P^[2U] . 

50(3) A point g on 5*0(3) is represented by a 3-dimensional rotation matrix Q. 

• Group multiplication, inverse and identity are the corresponding matrix operations. 

• The Lie algebra so(3) is the set of skew-symmetric 3x3 matrices [w]^, operations Lq^,^ and 
Rq*£, are represented by Q[ijj\'^ and [wJ^Q respectively. The invertible mapping 



G50(3) 







identifies so(3) 3 [lj]'^ with M? 3 lj. 

• With this identification, AcIquj = Qu and [o^^., ujj] ~ [LUk]^LUj = cuk x tOj (vector product). 

• In the standard interpretation of Q as rigid body orientation, cj' and uj^ are the angular 
velocities expressed in body frame and in inertial frame respectively. 

• LIC (equal w^), RIC (equal tul.) and TC have a clear mechanical interpretation in this case. 

• For TC with cu y^ 0, cmi^ = {Xuj : A G M} and CM^j = {rotations around axis uj}. 

The dimension of cm^i (<^ of CM^i) is 1; the agents rotate with the same angular velocity 
w^ in inertial space and have the same orientation up to a rotation around w^J. 



SE{2) The special Euclidean group in the plane SE{2) describes all planar rigid body motions 
(translations and rotations). An element of SE{2) can be written g = {r,6) 6 M^ x 5^ where r 
denotes position and 9 orientation. 

• Group multiplication 5192 = {ri +Qei'f2, 6'i +6*2) where Qg is the rotation of angle 9. Identity 
e = (0,0) and inverse g^^ = {—Q^gr, —9). 

• Lie algebra se(2) = M^ x M 3 <J = (w,cj). Operations Lg^,{v,uj) = {Qgv,uj) and Rg^{v,uj) = 
{v + ujQT,/2r,uj). 



• Adg {v,u!) = {Qev -ujQ^/2r,uj) and [(wi, wi), (w2, ^2)] = {^iQtt/2V2 - ^2Q^/2Vi,'i)- 

• In the interpretation of rigid body motion, v^ is the body's linear velocity expressed in body 
frame, w' = oj''' =: oj is its rotation rate. However, for w 7^ 0, u'' is not the body's linear 
velocity expressed in inertial frame. Instead, s = — ^vi^i- jg ^j^^^ center of the circle drawn 
by the rigid body moving with SJ' = (v^,uj). In [48], the intuitive argument to achieve 
coordination is to synchronize circle centers Sk', this actually means synchronizing right- 
invariant velocities w^, k = 1...7V (^ linear velocities expressed in inertial frame). 

• In RIC , the agents move with the same velocity expressed in body frame (Figure 1, r). In 
Lie , they move like a single rigid body: relative orientations and relative positions on the 
plane do not change (Figure 1, ^1 and 12)- 

• In TC , the swarm moves like a single rigid body and each agent has the same velocity 
expressed in body frame. Propositions 2 and 3 characterize cm^i by [£,'',11] = <^ a;'w,, = tj,,w' 
and CM^i by Adg ^' = ^' <;=> {Qg — Id)w' = LLi^Q^/2r. This leads to 3 different cases: 

(o) w' = u' = ^ cm^i = se(2) and CM^i = SE{2). 

(i) J = 0, I'V =^ cm.; = {(w,0) : u e M^} and CM^i = {(r, 0) : r G M^}. 

(ii) w' ^ 0, any w' ^ cm^i = {{-^v^lu) : w G K}. Define C, the circle of radius ^1|^ 

containing the origin, tangent to w' at the origin and such that u' and w' imply rotation 
in the same direction. Then solving Adg£ = ^ for g and making a few calculations 
shows that CM^i = {{r, 0) : r e C and Qev^ tangent to C at r}. This is consistent 
with an intuitive analysis of possibilities for circular motion with unitary linear velocity 
and fixed relative positions and orientations in the plane. 

The dimension of cm^; (<^ of CM^i) is (o) 3, (i) 2 or (ii) 1. In case (o), the configuration is 
arbitrary but at rest. In case (i), the agents have the same orientation and move on parallel 
straight lines (Figure 1, ii). In case (ii), they move on the same circle and have the same 
orientation with respect to their local radius (Figure 1, 12). 



SE{3) This group describes all 3-dimensional rigid body motions (translations and rotations). 
An element of SE{3) can be written g = {r, Q) <E M.^ x 50(3), with r denoting position and Q 
orientation. 

• 5152 = (''I + Qir2,QiQ2), identity e = (0,ld) and inverse g~^ = {-Q'^r,Q'^). 

• Lie algebra se(3) = M^ ^ 50(3) 3 £ = {v,[lu]^) is identified with M^ x R3 g {v,uj) with 
the same mapping as for 5*0(3). Operations Lg^{v, [u)]^) — {Qv,Q[ijj]^) and Rgt.{v, [uj]^) = 
(w X r + u, [tjJ^Q). As for 50(3), symbol "x" denotes vector product. 

• Adg {v,lS) = [Qv + r X {QlS),QlS) and [(wi,tJi), (w2,W2)] = [i^\ x 112 - ^^2 x vi,ti;i x ^2)- 

• In the interpretation of rigid body motion, left-invariant velocities w' and lJ- are the body's 
linear and angular velocity respectively, expressed in body frame; the right-invariant uf is 
the angular velocity expressed in inertial frame; for lJ- ^ 0, there is no intuitive physical 
interpretation for the right-invariant v^ . 

• Similarly to SE{2), the agents move in RIC with the same velocity expressed in body frame 
and in LIC with fixed relative orientations and relative positions, like a single rigid body. 

• In TC , the swarm moves like a single rigid body and each agent has the same velocity 
expressed in body frame. Propositions 2 and 3 lead to three different cases characterizing 



cm^i which requires [^' , 77] = O w' x cj,, = and w' x w^ 
CA'fy which requires Adg ^' = ^' <;=> Qw' = w' and {Q - Id)w' 



' ~ w' X r. 







ii^{ 




t2 



Figure 1: Coordinated swarms (light color: intermediate positions and orientations in time), r: 
RIC with varying velocity, li and l2'- LIC with ujk = and lu^ =/= respectively, ti and t2'. TC 
with uji; = and ujk =/= respectively. 



(O) LU^ 







(i) w' = 0, u' 7^ 



se(3) and CM^ 
cmci = {(/3, aw') :/3 g 



^^(3). 



a G R} and 
^, Q characterizes rotation of axis w'} 

= {(m/ + (3uj\auj'-) : a, (3 £ 



CM^i =.{{r,Q):re 

(ii) w' ^ 0, any w' ^ cm^; = {(m/ + pJ.aJ) : a, /? G K} and CM^z = {(r, Q) G S'£;(3) 
describing left-invariant relative positions of agents that are on the same cylinder of 
axis w' and radius ~ ii'iImi ' with orientations differing around axis uj^ by an 

angle exactly equal to their relative angular position on the cylinder }. This is again 
obtained by solving for g in Adg£^ = ^ and making several basic computations; it is less 
obvious than for SE{2) to find this result intuitively. 

The dimension of cm^; (<^ of CM^i) is (o) 6, (i) 4 or (ii) 2. In case (o), the configuration 
is arbitrary but at rest. In case (i), the agents move on parallel straight lines and have 
the same orientation up to rotation around their linear velocity vector. In case (ii), for 
v'' — (u') • (a;')/||a;'|| ^ 0, the agents draw helices of constant pitch ui'' ■ v^ = cu^ ■ v^ on the 
cyhnder; in the special case w' -w' = the trajectories become circular (see figures in [201 US])- 
In the degenerate situation v' — (w') • ([j')/||tj'|| = 0, all agents are on the rotation axis. 



3 Coordination as consensus in the Lie algebra 

3.1 Control setting 

Left-invariani|^ systems on Lie groups appear naturally in many physical systems, such as rigid 
bodies in space, and cart-like vehicles. Motivated by examples like 2-axes attitude control and 
steering control on SE{2) or SE(3), this paper considers a left-invariant dynamics with affine 
control of the type 



Tt9k 



Lgk*^k 



with 



^i = « - 



Buk 



, fc = l...iV, 



(2) 



^A right-invariant system is equivalent, simply by redefining the group multiplications. 



where the Lie algebra g is identified with M", a G M" is a constant drift velocity, B G ]]j"x™ j^as 
full column rank and specifies the range of the control term Uk £ W^ . The set of all assignable 
5[ is denoted C ~ {a + Bu : u G M™}. Note that for fully actuated agents m = n, ([2) boils down 
to ^Qk = Lg^^Uk. Feedback control laws must be functions of variables which are compatible 
with the symmetries of the problem setting, i.e. left-invariant variables. In terms of left-invariant 
variables, LIC corresponds to fixed (left-invariant) relative positions, while RIC corresponds to 
equal (left-invariant) velocities. 

In a realistic scalable setting, full communication between all agents cannot be assumed. The 
information flow among agents is modeled by restricting communication links among agents; j -^ k 
denotes that j sends information to k. The communication topology is associated to a graph G. 
G is undirected ii k ^^ j -i^ j ^^ k. G is uniformly connected (see |30| 129] ) if there exist an agent 
k and durations S > and T > such that, Vi, taking the union of the links appearing for at least 
S in time span [i, t + T], there is a directed path k ■--* a -^ b... -^ j from k to every other agent j. 



3.2 Right-invariant coordination 

Cl = fl 



Right-invariant coordination requires ^[ = ^' Vj, k. In the setting ^, this simply implies to agree 



on equal Uk Vfc; positions Xjk can evolve arbitrarily. This problem is solved by the classical vector 
space consensus algorithm [551 US [S3 13 [3S1 [31] 

M-E,^ki^j-^i) ,k^l-N, (3) 

that, using ([2|), translates into -^Uk = X]i~^fc (^i ~ ""fe)' ^^^^ exponentially achieves ^[ = ^j Vj, fc 
if G is uniformly connected. Agent k 
values of Uk can be chosen arbitrarily. 



if G is uniformly connected. Agent k relies on the left-invariant velocity ^' of j ~~> k; the initial 



For a time-invariant and undirected communication graph G, ([3]) is a gradient descent for the 
disagreement cost function Vr = J2k ^j-^k ll^fc ~ ^jW^ ' '^^^^ ^^^ Euclidean metric in g. 

3.3 Left-invariant coordination 

Left-invariant coordination requires ^^ = ^'' Vj, k, which suggests to use 

ia^E.^ki^^-^D ,k = i...N. (4) 

Using ll]) to rewrite ^ in terms of the left-invariant variables yields 

Mi = E.^kiAdg-^,, ej - el) , fc = 1-^ (5) 

thanks to jti^dg^^l.) = Adg^l^l, '?[•] = 0. To implement (jl|), agent k must know the relative 
position g^ gj and velocity ^' of j -^ k; the initial Uk are still chosen arbitrarily. 

The disagreement cost function Vi — J2k S,~^fc ll^'^sfc^l- ~ ^^Sj^jlP associated to (j4]) is not 
left-invariant in general (it involves positions gk) , so (O cannot be a left-invariant gradient of Vi . 

Nevertheless, let Gu be the subclass of compact groups with unitary adjoint representation, i.e. 
satisfying ||Adg ^|| = ||^|| \/g € G and V^ G g (for instance SO{n) G Gu)- It is possible to define 
a bi-invariant (that is, left- and right-invariant) Riemannian metric on G if and only if G G ^^ 
[2]. Using the Euclidean metric on left-invariant velocities, as in the present paper, comes down 
to using a left-invariant metric, in accordance with the left-invariant setting. If G G 5u, then this 
metric is bi-invariant, Vi = J2k^-i~^k ll^fc ~ ^"^o^^o ^511^ ^^'-^ ^'-"' ^^cd undirected G, ([5]) is a 
gradient descent for V(. 

A priori, the consensus algorithm ([51) converges as ^^. However, in contrast to ((31), nothing 
guarantees that ((51) can be implemented in an underactuated setting. At equilibrium, ((51) requires 

Adx.^ia + Bu.j) = a + Buk \/j,k , (6) 



which may or may not hold depending on the relative positions of the agents. This issue moti- 
vates the further study of underactuated LIC in Section 5. Similarly, total coordination requires 
simultaneous consensus on left- and right-invariant velocities. At equilibrium, this means that ^ 
must hold with equal controls Uk, i.e. 

Adx^, (a + Buk) = a + Buk Vj, k , (7) 

which also puts constraints on the relative positions of the agents. For this reason, total coordi- 
nation is further studied in Section 4. 

In the following, it is assumed that the agents are controllable. Obviously, controllability is 
sufficient for coordination as it allows the agents to reach any position from any initial condition. 
However, it is not always necessary, as long as positions compatible with (O or ([71) are globally 
reachable; in particular, for Abclian groups Adg = Id \/g so any positions satisfy ^ and ([7]); in 
that case, (underactuated) LIC and TC become trivial. 

4 Control design: fully actuated total coordination 

4.1 Total coordination on general Lie groups 

Total coordination requires to satisfy two objectives, LIC and RIC , simultaneously. In a first 
step, assume that the agents have at their disposal a reference right-invariant velocity SJ" which 
they can track, such that LIC is ensured if S\. = Ad'^^"^ Vk. It remains to simultaneously achieve 
RIC , which, as previously shown, involves controlling relative positions. Writing 

^i = vi+qk, k = l...N, (8) 

where 77^ := Ad~^£,'^, the question is how to design q^ in order to achieve TC . For fixed undirected 
communication graph G, inspired by the cost function for RIC , define 



Vtri9i,g2-9N) = ^EkEj-^k hi-vlW 



where || || denotes Euclidean norm. Vtr characterizes the distance from RIC assuming that every 



agent implements ^^ = Ad^^^. The time variation of Vtr due to motion of g^ is 



where • denotes the canonical scalar product in g, because ■^{Ad~^)ri = —[£,{., Ad'^.hj] V?/ G g. Thus 
ii qk ~ then ^Vt,- = 0, and a proper choice of qk should allow to decrease Vtr- Define^ ( , ) such 
thatei-(6,6) + Ki,6]-6 = ova, 6, 6 e g; then © rewrites ^14, - 2 EkEj-^k ivlvi^rp-qk 
and the choice 

<ik = -{vlE,^kivi-v',)) (10) 

ensures that Vtr is non-increasing along the solutions: 

ivtr - -2 Ek E,^k ivl E,-^k {vi - i)? < . 

To obtain an autonomous, left-invariant algorithm for total coordination, it remains to replace 
the reference velocity ^ by agent-related estimates 77^ on which the agents progressively agree. As 
the goal is to define a common right-invariant velocity in g, it is natural to proceed as in Section 

and use the consensus algorithm 

ivl-E,^kiv--vl) (11) 



^In fact, ( , ) expresses the effect of the Lie bracket on the dual space of g, and is directly related to the coadjoint 
representation of G; note however that in general, ( , ) does not satisfy the Lie bracket properties. 



which in terms of left-invariant velocities rewrites 






Ej^kiAdx,, -q] - r/i) - K[, ryi] , k^\...N. 



(12) 



Thus the overall controller is the cascade of a consensus algorithm to agree on a desired velocity 
for Lie , and a position controller designed to decrease a natural distance to RIG . To implement 
the controller, agent k must receive from communicating agents j ~-» fc their relative positions Ajfe 
and the values of their left-invariant auxiliary variables 77' . 



Lie : agree on ^'" 

vector space consensus in g 



RIG : agree on Ad'^^'' 

Lyapunov-based control of g^. 



Figure 2: Total coordination as consensus on right-invariant velocity and Lyapunov-based control 
to right-invariant coordination. 

The following result characterizes the convergence properties of controller ([5|). (|10|) . p^ . 

Theorem 1: Consider N fully actuated agents communicating on a fixed, undirected graph G and 
evolving on Lie group G according to ^gk = Lgi^^S,\ with controller ((8|) . (fTO|) . (fT2|l . 



(i) For any initial conditions ??[.(0), the if^{t) exponentially converge to rf' := -^ ^j. ?7fc(0). 

(ii) Define Vtrigi,g2, ■•■gw) := ^J2k J2j~^k W^'^gk^ ^ ^'^g/'f IP- AH solutions converge to the 
critical set of Vtr- In particular, left-invariant coordination is asymptotically achieved. 

(iii) Total coordination is (at least locally) asymptotically stable. 

Proof: Regarding convergence, (fT^ is strictly equivalent to (fTTj) . Therefore, (i) simply restates 
a well-known convergence result for consensus algorithms in vector spaces on fixed undirected 
graphs [34] . 

Since the 77^ converge, ([5]) , (jlOp is an asymptotically autonomous system; the autonomous limit 
system is obtained by replacing rj^ = Adg^rf. From the derivation of qk in PU)) . the limit system 
is a gradient descent system for Vtr{gi,g2, ■•■^jv); the latter is smooth because the adjoint repre- 
sentation is smooth. According to [H] , the w-limit sets of an asymptotically autonomous system 
correspond to the chain recurrent sets of the limit system. Moreover, from [M] the chain recurrent 
set of a smooth gradient system is equal to the set of its critical points. Therefore the w-limit set 
of ([Sjl- PU]) is equal to the set of critical points of Vtr, which proves (ii). Total coordination Vtr = 
is locally asymptotically stable as it is a local (and global) minimum of Vtr, which proves (iii). A 

Extensions to varying and directed G can be made with additional auxiliary variables along 
the lines of [151 [HI 1^ [15] : the algorithms define (estimate) a desired ^' and a desired ^'", which 
must be on the same adjoint orbit; cost functions for individual agents are used to ensure that 
they asymptotically implement the desired velocities. Sometimes intuition may be required to 
express everything in a left-invariant setting. These algorithms mostly overcome the problem of 
local minima different from TG , which makes them useful for fixed undirected G as well. 



4.2 Total coordination on Lie groups with a bi-invariant metric 

When G e Qu, i.e. G has a bi-invariant metric, the cost function Vi = J2k^i~^k W^'^gk^i ~ 
Adg.^jW^ can be used for left-invariant control design. 

A natural idea in this context would be to combine the cost functions for LIG and RIG , writing 
Vt ^Vi+Vr, and derive a gradient descent for Vt of the form ^^[ = /(5[, {^j, g^^gj ■ j -^ k}). 
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However, simulations of the resulting control law for SO{n) seem to always converge to ^[ = 
Vfc. A possible explanation for this behavior is that this strategy focuses on velocities, such that 
positions of the agents are not explicitly controlled, while it was shown in Section 2 that TC at 
non-zero velocity involves restrictions on compatible positions. 

Nevertheless, the existence of a bi-invariant metric offers the possibility to switch the roles of 
Lie and RIG in the method of Subsection 4.1, using a consensus algorithm to define a common 
left-invariant velocity for RIG , and a cost function to drive positions to LIG . 



RIG : agree on S} 

vector space consensus in g 



LIG : agree on Adg^^ S} 

Lyapunov-based control of g^, 



Figure 3: Total coordination as consensus on left-invariant velocity and Lyapunov-based control 
to left-invariant coordination. 



The RIG consensus algorithm on auxiliary variables asymptotically define a common velocity 



fby 



dt^k 



E.^. ii 



vi) 



1...N . 



Then defining the cost function 



Vu{gi,g2...gN) = ^EfcE.^fe \\Adg, vi - Ad^^ ryjf = ^EkE^^k Wvi Ad^-r^^ rf^f 
for LIG and proceeding as in the previous subsection, one obtains controller ([5]) with 



(13) 



Qk 



{^llE,^,irii-Ad-.n^)) 



(14) 



Theorem 2: Gonsider N fully actuated agents communicating on a connected, fixed, undirected 
graph G and evolving on Lie group G £ Qu according to j^gk = Lg^^^l with controller ([8l).(fT3 l ([T4 |) ). 

(i) For any initial conditions f?fc(0), the r?[.(i) exponentially converge to 77' := jj Ek ^l-(O)- 

(ii) Define Vti{gi,g2, ■■■gN) ■= lJ2kJ2j-^k ll^'^stV - Adg.rj'W^. All solutions converge to the 
critical set of Vu- In particular, right-invariant coordination is asymptotically achieved. 

(iii) Total coordination is (at least locally) asymptotically stable. 
Proof: The proof is omitted because it is similar to the one of Theorem 1. A 

An advantage of Theorem 2 over Theorem 1 is that the control design can be directly extended 
to underactuated agents. Indeed, P^ defines a valid consensus velocity ^' G C = {a+Bu : u G M™) 
for underactuated agents provided that /^^.(O) £ C yk. The only change is that qk, instead of the 
exact gradient descent in (fH]) . is its projection onto the control range of B: 

£.i=a + Buk= vi + B B^qu 

assuming without loss of generality that the columns of B arc orthonormal vectors. When ^' is 
asymptotically defined with (J13p . the convergence argument for asymptotically autonomous sys- 
tems must be extended to projections of the gradient system p4|) : a general proof of this technical 
issue is lacking in the present paper. It is the only reason to restrict Theorem 2 to fully actuated 
agents. 
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Brockett [S] has developed a general double-bracket form for gradient algorithms on adjoint 
orbits of compact semi-simple groups, using the bi-invariant Killing metric. The connection with 
the present paper is obvious: once the consensus algorithm has converged, the gradient control for 
agent positions involves a cost function on the adjoint orbit of the common velocity r/ or jf. One 
example in [S] involves minimizing the distance towards a subset of g; a similar objective will be 
pursued in Section 5 of the present paper (but with a different class of subsets). A main difference 
of [8] is its focus on the evolution of variables in g, making abstraction of the underlying group, 
while in the present paper one actually controls the positions of (possibly undcractuated) agents 
on G. If G is a compact group and the bi-invariant Killing metric coincides with the left-invariant 
metric of the present paper, then (,) = —[,] and control (flU)) for gk with 77^ = ^'' fixed implies 



that 77!. follows the double bracket flow 



fA = [viAvlE,^M-v',)]]- (15) 

This is the case among others for the following example in 50(3). 

4.3 Example: Total coordination in S0{3) 

Control laws for coordination in SO(3) abound in the literature — see among others the papers 
about satellite attitude control mentioned in the Introduction. Total coordination on SO{3) 
requires aligned rotation axes, and thus synchronizes satellite attitudes up to their phase around 
the rotation axis. 

The compact group 5*0(3) has a bi-invariant metric, so the approach of Section 4.2 can be 
applied. Algorithm ([T3|) is used verbatim, with ry^, £ K^ the auxiliary variable associated to angular 
velocity w[,. As mentioned before equation ([TS]), (,) = —[,] on 50(3). Thus in the fully actuated 
case, ([H]),(|I11) lead to 



UJ 



I — „l I ,J .. (-v^ niTni „l 



k - 4 + vl X (E.^fc Qi Q,ii) . k = 1...N . (16) 

Theorem 2 can be strengthened as follows for specific graphs. 

Proposition 4-' If G is a tree or complete graph, TC is the only asymptotically stable limit set. 

Proof: According to Theorem 2, it remains to show that TC is the only local minimum of Vu. 
Fixing 77^ = w' Vfc, critical points of Vu correspond to 

(Qfc^') X (E^.^^QX) = Vfc. (17) 

For the tree, start with the leaves c. Then {QcOj'') x (Qpw') = where p is the parent of c. As 
a consequence, (fTT]) for the parent becomes (QpCj') x (Qj^w') = where pp is the parent of p. 
Using this argument up to the root, all (Qfew') must be parallel. If the agents are partitioned in 
two anti-aligned groups, then moving those groups towards each other decreases Vu; thus Vu ~ 
is the only local minimum. For the complete graph, ([T7|) becomes {Qk^j'') x ip = Vfc, where 
ip = J2i Qj^^ ■ This implies either that all Qfcw' must be parallel or that t/j = 0. In the first 
case, further discussion is as for the tree. Rewriting Vu = N^ ll^'P — 5V' ' "0 shows that ip = 
corresponds to a maximum of Vt . A 

It is straightforward to adapt (|16p for undcractuated agents; a popular undcractuation on 
50(3) is to consider 2 orthogonal axes of allowed rotations ei and 62, cither controlling both 
rotation rates, i.e. w[. = uiei -I- 7^262, or imposing a fixed rotation rate around one axis, i.e. 
uj'j^ = ei + 7^262. Both cases are controllable [16], so the Jurdjcvic-Quinn theorem ensures local 
asymptotic stability of TC , if 77J, = 77' \/k is fixed in advance or agreed on in finite time. A formal 
convergence proof for the asymptotically autonomous case where the 77^ follow (|13|1 is currently 
missing. 
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5 Control design: underact uated left-invariant coordina- 
tion 

Total coordination may appear as a rather academic example, whose motivation in applications is 
not clear. However, the methodology developed in Section 4 for TC control design is instrumental 
to achieve left-invariant coordination of underactuated agents. The latter is well motivated by 
practical applications. Here the role of the cost function is no longer to add a second level 
of coordination, but to fulfill the undcractuation constraints. Unlike the academic example of 
TC , the present section explicitly considers LIC control design in the most general setting of 
underactuated agents as well as possibly directed and time- varying interconnection graph G. 

5.1 Left-invariant coordination of underactuated agents 

The control design of underactuated left-invariant coordination is decomposed in the two steps 
illustrated in Figured) In a way analogous to the total coordination design of Section 4.1, a feasible 
right-invariant velocity is determined by a consensus algorithm. The corresponding left-invariant 
velocity is enforced by a Lyapunov-based feedback that decreases the distance of the consensus 
velocity to C = {a + Bu : u e M™}. 

The consensus algorithm must enforce a feasible right-invariant velocity, that is a vector ^^ in 
the set 

Oc := {Adg^ : e e C and .9 e G} . 

If Oc is convex, then it is sufhcient to initialize the consensus algorithm (|12p with /^[(O) G C. 
When Oc is not convex, the consensus algorithm must be adapted and the present paper has no 
general method. Strategies inspired from |40| for compact homogeneous manifolds may be helpful, 
as illustrated in the example below. 

Assuming a known feasible right-invariant velocity ^^ , the design of a Lyapunov based control 
to left-invariant coordination proceeds similarly to Section 4.1. 

Define d{T], C) to be the Euclidean distance in g from rj to the set C. Let Hciv) be the projection 
of 77 on C; since C is convex, Vry liciv) is the unique point in C such that d{r], C) = d{r], nc(ry)) =: 
\\ri — nc(r/)||. Following the same steps as in Section 4.1, define r/^ := Ad"^^'". Writing 

^i = a + Buk = ncivi) + Bqk , k^l...N, (18) 

the task is to design q^ G M™ such that asymptotically, g^ is driven to a point where i/f. G C and 
Qk converges to 0; this would asymptotically ensure LIC . For each individual agent k, write the 
cost function 

Vkigk) = hJ\Ad-^'C-Tlc{Ad-^'nr = \\\^\~^c[ni)f (19) 

where || || denotes Euclidean norm. Vfe characterizes the distance of rf^ from C, that is the distance 
from LIC assuming that every agent implements ^[ ~ Ilc{Ad~^^^). The time variation of Vk due 
to motion of gk is 

iVk = ivi - ^civi)) ■ [vl ^civi) + Bqk] (20) 

where • denotes the canonical scalar product in g. Going further along the lines of Section 4.1 
requires to assume that the control setting (pair a, B) and Lie algebra structure are such that 
Vr? e Oc, it holds (77 - Udrj)) ■ [rj, Udrj)] < 0; then ^ implies -^Vk < fivl) ■ qk for some 
continuous / : — > K™ and a natural control is 

qk = -f{vi), k = l...N. (21) 

Note that when O^r C C, the position control algorithm is unnecessary and vanishes, yielding 
simply e[ = Ad-^ Vi. 

The overall controller is the cascade of a consensus algorithm to agree on a desired velocity for 
LIC , and a position controller designed from a natural Lyapunov function to reach positions com- 
patible with undcractuation constraints and actually achieve LIC . To implement the controller, 
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agent k must get from other agents j -^ k their relative positions Xjk and the values of their left- 
invariant auxiliary variables rf^. Since agents only interact through the consensus algorithm, not 
through the cost function, a connected fixed undirected graph is not required: G can be directed 
and time-varying, as long as it remains uniformly connected. 



Agreement: define feasible ^'' e Oc 

synchronization on manifold 




Implementation: drive Ad^^S,"^ to C 

Lyapunov-bascd control of g^ 





Figure 4: Underactuated left-invariant coordination as constrained consensus on right-invariant 
velocity and Lyapunov-based control to left-invariant coordination. 

A general characterization of the behavior of solutions of the closed- loop system is more difficult 
here because the position controller is not a gradient anymore. The following result involves 
assumptions that can be readily checked for any particular case. 

Theorem 3: Consider N underactuated agents communicating on a uniformly connected graph 
G and evolving on Lie group G according to ^gu = Lg^^^^^l with controller (fT8|) . ((2T|) . assuming 
that \/ri S Oc, it holds (77 — nc(77)) • [rj, Ilc{r])] < 0. Assume that an appropriate consensus 
algorithm drives the arbitrarily initiated rj^., k = 1...N, such that they exponentially agree on 
Adg^r]l. -^ ^'' G Oc Vfc, independently of the agent motions gk{t)- 

(i) If the agents are controllable, LIC is locally asymptotically stable. 

(ii) If, for any fixed r/^ = ^'', bounded Vk implies bounded r/^, and f{ri\?) -^ implies gk -^ {g '■ 
f{Adg^ril) ~ 0}, then all agent trajectories on G converge to the set where f{Adg^(,^) ~ 0. 

Proof: The overall system is a cascade of the exponentially stable consensus algorithm and position 

controller p^ . l^Tj) which is decoupled for the individual agents. Assumptions -^Vt < fivi) ' 9fc 

and pTj) exactly mean that Vk{gk) is non-increasing along the closed- loop solutions. Therefore, if 

the agents are controllable, Jurdjevic-Quinn theorem [17| implies local asymptotic stability of the 

local minimum Vfc = Vfc for the position controller. Then the overall system is the cascade of 

an exponentially stable system and a system for which 14 = V/c is locally asymptotically stable. 

Standard arguments on cascade systems (see e.g. [SJ EZ]) allow to conclude that Vk = V/c is 

locally asymptotically stable for the overall system; this proves (i). 

To prove (ii), first consider the case where 77^ = ^"^ constant Vk. Then Vk can only decrease, and 

since it is bounded from below it tends to a limit; therefore -^Vk is integrable in time for t — > -l-oo. 

For the same reason, Vk is bounded, so according to the assumption for (ii) 77^ is bounded as well; 

,2 . 

then 3^Vfc, which is a continuous function of 77^, is bounded as well for the closed- loop system, 

such that -^Vk is uniformly continuous in time for t -^ +00. Barbalat's Lemma implies that ^V^ 

converges to 0, which implies that /(7;[) converges to 0, concluding the proof. Now in fact rj^ 

is not constant but exponentially converges to the constant value ^'' V/c. But this changes noth- 

,2 
ing to the fact that Vk tends to a finite limit and -^Vk is bounded, so the same argument applies. A 

Condition -^Vk < fivi) ' Ik in Theorem 3 is not always true when a 7^ 0; however, it is often 
satisfied in practice, as for steering control of rigid bodies in the following example. For this 
example, it is also possible to slightly improve Theorem 3 by showing that LIC is the only stable 
limit set. 

5.2 Example: Steering control on SE(3) 

Left-invariant coordination on 5i?(3) under steering control is studied in |461 I43j. The present 
section shows how the algorithms of [46] follow from the present general framework. 
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Using the notations of Section 2.3, the position and orientation of a rigid body in 3-diniensional 
space is written (r-fc, Qk) =: gk, which is an element of the Special Euclidean group SE{3); group 
multiplication is the usual composition law for translations and rotations, see Section 2.3. Then 
requiring agents to "move in formation" , i.e. such that the relative position and heading of agent 
J with respect to agent k is fixed in the reference frame of agent k, Vj, A;, is equivalent to requiring 
left-invariant coordination. Moreover, since linear and angular velocity in body frame correspond 
to the components (v^,w[,) of ^^, the problem of controlling each agent in its own frame with 
feedback involving relative positions and orientations of other agents only, fits the left-invariant 
problem setting described in Section 3. The constraint of steering control — i.e. fixed linear 
velocity in agent frame w[ = ei — implies ^ of the form 

Ci^a + Buk^{ei,Uk) ^ C = (ei,R3). 

Steering controlled agents on SE{3) are controllable [l6] . 

Following the method of Section 5.1, write auxiliary variables ry[ = ivik'^Lk)' then nc(?y^) — 
(ei, ?/^ J,), cost function Vk ~ ^Wvik^^'^W'^ and straightforward calculations show that (P0|) becomes 
Ti^k = (jy^fc X ei) • (7fe. This means that {i] - Uc{ij)) ■ [?7, Udr])] = and /,,j^ = (t?;,^, x ei). Then 
dill), (EH) yield the controller 

Uk = vlk + eiXvU, k=l...N. (22) 

This is the same control law as derived in |46| from intuitive arguments. If an appropriate consensus 
algorithm is built, then all assumptions of Theorem 3 hold, implying local asymptotic stability 
of 3-dimensional "motion in formation" with steering control ([H]); in fact, [H] slightly improves 
Theorem 3 by also showing that globally, LIC is the only stable limit set. 

It remains to design a consensus algorithm for the 77J.. For this, two cases are distinguished, 
as in [IS]: linear motion w'' = and helicoidal (of which a special case is circular) motion w'' ^ 0. 
The first case (almost) never appears from a consensus algorithm with arbitrary 77[.(0); it can 
however be imposed by 77^ ^,(0) = Vfc, which will then remain true Vi > 0, in order to stabilize a 
coordinated motion in straight line. 
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If vlk = (linear motion), then r,[ , = Qlr^^^ and 0(e,,o) = {(A,0) G R^ x R^ : ||A|| = 1}. 
Agreement on v^ in the unit sphere can be achieved following |40| . just achieving consensus 
in R"^ and normalizing; in fact normalizing is not even necessary, as it would just change the 
gain in ([H]). This leads to 



fAk = Ej^kiQiQiVlj ~vU)~UkXrjl^, k = 1...N, (23) 



again as m 



If ^Lfc 7^ 0> then vlk = QlvLk and 7?^,^ = Qlril^ - [Qlrk) x {Qlril^), and Oc = {(7 + 
/3 X a, a) : a,/3,7 G M? and ||7|| < 1}. Designing a consensus algorithm, that achieves 
agreement on SJ^ G Oq and can be written with left-invariant variables, appears to be difficult. 
Similarly to the first case, suitable algorithms can be built if the overall dimension of the 
variables used for the consensus algorithm is enlarged with respect to the dimension of 
the configuration space. The consensus algorithm proposed in [46] replaces rj\. by three 
components as, = 77^ j, G R'^ , /3fc G R'^ and 7fc G R'^ associated with the vectors a, (i, 7 used 
to describe Oc above; then ry^ = (?7^j., 7?^^) = {"fk + /3fe x afc, ak)- The advantage of this 
embedding ?/^ — > {ak, f3k,Jk) is that left-invariant consensus algorithms can be decoupled 
for the ak, the Pk and the jk- With the notations of the present paper, the corresponding 
consensus algorithm proposed in [46j is 

ji<^k = Y^j-^kiOkQi^] - ^k) -UkX ak 

iPk = E.^fc iQlQjP, -Pk + Qlirj -rk)) ~UkX Pk - ei 

^7fc = Hj-^kiQlQjlj-lk) -Uky-lk , k = l...N. 
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Comparing the left-invariant relative position g^ qj = {Q'kiTj — ^k), Q'kQj) with the terms 
and factors appearing in this consensus algorithm, one observes that the latter is indeed 
left-invariant. It can be verified (see [JS]) that this algorithm indeed synchronizes the 
r]l. = Adg^ {"fk + [ik'X- o-k, au)- 

Remark 3: LIC in linear motion, i.e. with ?7^ ^ = Vfc, under steering control requires to align 
vectors Qk^i for all agents. This is in fact equivalent to TC on 5*0(3) with jy^. = w' = ei \/k. The 
present section thus illustrates the method for TC on 50(3) for uniformly connected G (instead 
of fixed undirected G as in Section 4) . 

Remark 4- LIC under steering control on SE{2) is treated in [I^IH^. As for 5£'(3), control 
algorithms obtained intuitively, with several simplifications due to the lower dimension, can be 
recovered with the general method of the present paper. 

In fact, the group structure and control setting of steering control on SE{2) are such that 
Vg G SE{2) and V steering controls u G R, one has 

C = Adg^'^ = Adg{a + Bu) = a{g, u) + Bu with a(g, u) ±Bu; (24) 

On SE{2) explicitly, a + Bu = {ei,u) G M^ x M and Adg{ei, u) = {Qe^i —uQj,/2r, u), so a{g, u) ~ 
(Qe^i ^uQt^/2^\ 0) a-nd Bu ~ (0, u). Then LIC automatically implies equal u^, thus RIC , meaning 
that underactuated LIC is equivalent to TC and imposes the same constraints on relative positions 
Xjk- This is the case for any group and control setting satisfying ()24|) . 

For steering control on SE{3), LIC is slightly different from TC because Adg{ei, u) = {Qei + 
r X {Qu),Qu), so ([231) would require (Qu) ■ (Qei) = u ■ ei =0 which is not true in general. 
Therefore, for LIC under steering control the uj^. = ut can differ by arbitrary rotations around ei , 
while TC would require equal u)\. 

6 Conclusion 

This paper proposes a geometric framework for coordination on general Lie groups and related 
methods for the design of controllers driving a swarm of underactuated, simple integrator agents 
towards coordination. It shows how this general framework provides control laws for coordination 
of rigid bodies, on groups 50(3), SE{2) and SE{3), and allows to easily handle different settings. 
Following the numerous results about coordination on particular Lie groups, various directions 
are still open to extend the general framework of the present paper. A first case often encountered 
in practice is to stabilize specific relative positions of the agents ("formation control"). In [48|, I49| 
for instance, the steering controlled agents on SE{2) are not only coordinated on a circle, but regu- 
lar distribution of the agents on the circle is also stabilized; in the present paper, relative positions 
of the agents are asymptotically fixed but arbitrary. The requirement of synchronization (most 
prominently, "attitude synchronization" on 50(3)) also fits in this category. A second impor- 
tant extension would be to consider more complex dynamics, like those encountered in mechanical 
systems. 
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